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1. INTRODUCTION 

Nowadays, autonomous wheeled mobile robots are used in logistics to transport materials 
automatically, components, supplies, products, and sell products, in intelligent manufacturing and logistics 
systems [1]. In consideration of a complicated working environment and tight spaces, which is not enough to 
design the turning radii for the robot, lead to mecanum-wheeled mobile robot (MWMR) has been developed 
to satisfy the whole smart logistics systems and the modern industrial environment [2]. In intelligent 
manufacturing, the MWMR is integrated with an industrial JoT-based system to intra-factory logistics 
automation [3]. In addition, the MWMR is also integrated with a manipulator to perform different tasks such 
as: machining large-scale wind turbine blades by the mobile robots [4]; the robot surveillance of the Super 
Proton Synchrotron accelerator of the European Organization for nuclear research [5]; and the aromatherapy 
robot delivers therapeutic vaporized essential oils or drugs needed to prevent or treat Covid-19 infections [6]. 
However, for the MWMRs to work effectively in a system the main problem is to control its movement 
precisely following the desired trajectory. Therefore, many controllers have been proposed to control the 
MWMkRs to follow the desired trajectory, such as: the linear state feedback controller [7], [8]; recommended 
controller based on the combination of the robust sliding mode observer with the adaptive controller 
[9]-[11]; the fuzzy controller [12] or the fuzzy-proportional integral (fuzzy-PI) controller adjusts the 
parameters to decrease the position and posture errors of the robot due to the dynamic changes and 
navigation challenges [13], [14], using genetic algorithm to find near-optimal travelling path in logistics task 
scheduling problem for a mobile robot [15], and robust nonsingular terminal sliding model-based controller 
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design for the path-following problem with higher tracking precision [16], [17]. Thereby it can be seen 
advanced controllers have demonstrated outstanding potential, but the complex controller structure requires 
the processor and the memory capacity of the hardware is large. Thus, proportional integral derivative (PID) 
is still the favourite in mobile robot control applications especially in the case of path tracking control 
problems for the robot [6], [18], [19]. But, when the trajectory is complex and the desired velocity varies with 
time, the time-invariant parameter PID controller does not efficiently control the system because the accuracy 
is not high. A robot cannot be asymptotically stabilized to an arbitrary point by a smooth, time-invariant 
controller. With the above disadvantage, there has been a constant effort to design higher performance PID 
controllers for all possible parameter variations, such as the fuzzy PID controller has been proposed in 
[20], [21]; the controller is designed based on the sliding mode control method combined with PID; the 
artificial neural network-based adaptive law is introduced to model and estimate the various uncertainties 
disturbances [22]. These improvements have improved the accuracy and efficiency of traditional PID 
controllers, simultaneously significantly reducing the hardware's processing speed and capacity versus 
modern controllers. Which primarily ensures that the MWMR adheres to its predefined desired path is 
complex with the velocity is continuously changing. Also, to avoid sudden changes in the robot velocities, 
we use the non-uniform rational B-spline (NURBS) curve to design the simulation and experimental problem 
path to verify the efficiency of the controller designed by this study. 

Compared to the other research, this paper focuses on designing a PID controller with time-varying 
parameters via the error function to meet the trajectory tracking of the MWMR with minor errors. The 
remainder of this paper is organized as follows: a time-varying PID controller to control the MWMR to track 
the NURBS trajectory with minor errors, while the robot linear and angular velocities are time-varying are 
presented in section 2. Section 3 presents the method of setting up the simulation and experimental 
parameters for the MWMR. Section 4 presents the designed controller installed on a practical MWMR 
platform to the NURBS trajectory tracking. Simulation and experimental results are presented to evaluate the 
usefulness of the designed controller. Finally, we discuss the advantages and limitations of the proposed 
controller and present our conclusions in section 5. 


2. CONTROLLER DESIGN WITH TIME-VARYING PARAMETER 
2.1. Kinematic model 
Consider a MWMR moving along the trajectory ¢ in the global coordinate 0 -{O ¢x¢yf}, as shown in 


Figure 1(a). The relationship between the wheels angular velocities and the robot linear and angular 
velocities is determined by [7]. 
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r, L, d are the wheel radius, the distance between the two wheels, the distance between the front and rear 
wheels, respectively. Meanwhile, V;, V, and Q are the linear and angular velocities of the robot, while Q(@) is 
the rotation matrix from the local coordinate Jp{Gxgyp} (mounted on the robot) to respect the global 
coordinate Vs. From (1), the forward kinematics equation of the MWMR is as shown in. 


å = Qh) 4r = APU)" w (2) 
With q = [x y @]? is the vector of generalized coordinates in global coordinate Dp. 


2.2. Kinematic error model 

Let qalt) = [xa(t) Yalt) da(t)]’ be the desired trajectory € of the robot in the global 
coordinate Vs. The vector e = qa(t) — q(t) = [Px €y ep]" describes the position and posture errors of 
the MWMR when moving along the desired trajectory č (see Figure 1(b)), then transform e from the global 
coordinate to the local coordinate. The error model can be written as shown in: 


er = [xr eyr Ser" =Q" (p)e (3) 
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derivative (3), then combined with (2), results in a nonlinear error model of the MWMR. 

êr = Neg + RG, - Å (4) 
0 A(t) 0 


-A(t) 0 0 
0 0 0 


Wherein 2 = 


COS Cy — sin ep 0 
and R = [sin Cy COS Cy 0 | 
001 


Figure 1. Schematic the kinematic relationship of the MWMR with (a) the robot geometry kinematic and 
(b) the robot position and posture errors 


2.3. Controller design 

The linear error model of the MWMR is established by linearizing (4) around the working point 
with the desired values p(t) ~ Øar(t) and Qp(t) = Nar(t). Thus, (coseg ~ 1, sineg ~ eg) then 
substituting into the (4) the linear error model in the local coordinate Jp is given. 


ÈR = Aer + lzx3u (5) 
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Where A=]-A(t) 0 V(t) |, u= [vx evy eal’ = ẹVra >V% Vya-Vy Qa —Q]" is the 
0 0 0 

control variable vector and [3x3 is the unit matrix. The control law to reference trajectory tracking of the 


MWMR is designed as shown in [23]: 


de 
Cvxr = Kpexr + K; J exrdt + Kp ae 


d 
evyr = Kpeyg + K; f eypdt + Kp = (6) 


d 
en = Kpegr + K; f egrdt + Kp oh 


with parameters Kp, Ki, Kp of the time-varying PID controller depend on the error function e = yeg + ef 
when the MWMR moves along the desired trajectory éd is described by [24]. 


Kp = a, + œe 
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Here ai, bi, ci are the control coefficients (i=1,2). Assume that the wheels and road surface are free of 
hysteresis and the robot has no longitudinal and transverse slip. Based on the kinematic error model and the 
control law established above, the trajectory tracking controller with the time-varying parameter is designed as 
shown in Figure 2. In which the transform block is given by (3), PID controller block is the control law is 
represented by (6), the kinematic block is described by (2). 


Pa 


x ) 
Lagi Ce 
F, Transform ae Q) Q í 


Figure 2. Block diagram of the time-varying parameter PID controller 


3. SIMULATION AND EXPERIMENTAL SETUP 
3.1. Simulation parameters setup 
3.1.1. Dimensional of the robot 
Length x width x height (380 mm x 260 mm x 165 mm), L=316 (mm), d=270 (mm), radius of 
wheels 7=30 (mm). 


3.1.2. Motion trajectory design 

Nowadays, there have been many different solutions to design motion trajectories for mobile robots, 
as presented in the introduction. In this study, to generalize and smooth the motion trajectory to prevent the 
robot from having sudden speed changes at bends, we NURBS curve interpolation method to design the 
desired motion trajectory of the robot [25]. The dashed line in Figure 3 shows the desired motion trajectory 
of the designed robot after performing interpolation in MATLAB software with grid nodes A; (i=1-14). 


g 1f +* Output 


Figure 3. Simulation model for NURBS trajectory tracking of the MWMR in Matlab/Simulink 


3.1.3. Determination of motion parameters 
From the desired motion path &d, the time-varying velocity Vd(t) of the robot is determined by: 


24 
v(t) = = — Vei TXi- = ~ Yi-1)? (8) 
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with Vamax=0,25 m/s is maximal allowable velocity. Thus, the desired angular velocity Qd of the robot when 
moving on curved arcs is given by: 


Valt) 
Ul = O (9) 


in which, p;(t) E [pMaxmin is the radii of curvature of the desired trajectory 6d moving with i=1,2. n and is 
defined: 
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3.1.4. Determine the coefficients of the controller 

The trial and error technique to minimize error is applied to determine the coefficients ai, bi, ci 
(i=1,2) by the simulation model as shown in Figure 3. Table 1 is the data of the controller coefficients that 
have been selected to minimize the NURBS trajectory tracking error. The data in Table 1 and Figure 4 
describe the time-varying parameters of the PID controller for the MWMR to follow the NURBS trajectory 
with minimal error. 


Table 1. The coefficients of the controller 
ay ar bı by C1 C2 
0.001 0.001 0.001 0.581 0.001 0.001 


Figure 4. Time-varying parameter of the PID controller according to the error function e 


3.2. Experimental setup 
3.2.1. Hardware architecture 

The hardware architecture is distributed over two frames, as shown in Figure 5, where each frame is 
5 mm thick mica to ensure lightness and rigidity. In which i) the lower frame includes the following devices: 
1) drive: four mecanum wheels connected to integrated DC servo motor with integrated planetary gear 
reducer with gear ratio 1:14 and encoder 500 counts per revolution (CPR) (2 channels A-B, 500 pulses); 
2) four 43 A H-bridge motor driver modules (BTS7960); and 3) the robot is electrically powered by four 
Lithium batteries Lifepo4 33140 (3.2 V-15 Ah), which enable it to operate for about 5 h; ii) the upper frame 
includes the following devices: 1) the higher-level controller is an embedded computer (Raspberry Pi 4 
model b) for multi-sensor data processing; 2) the lower-level controller is a module Arduino (ATmega 2560 
R3) for motion control; and 3) the INS and obstacle detection system includes a Waveshare 6 degrees of the 
freedom (DOF) inertial measurement unit (IMU) sensor (SEN0386) and two LIDAR delta 2 A positioning 
scanners; iii) the upper frame includes the following devices: 1) the central processor is an embedded 
computer Raspberry Pi 4 model b; 2) control module Arduino ATmega 2560 R3; and 3) the INS and obstacle 
detection system includes a Waveshare 6 DOF IMU sensor (SEN0386) and two LIDAR delta 2 A positioning 
scanners; iv) communication: connect between host and robot by module WiFi integrated with an embedded 
computer; and v) robot control software is developed on ROS operating system. 

The experimental design in Figure 5 is made based on the calculated data according to Figure 3. 
Practical measurement data position (Xc, yc) and robot posture angle (@) are determined through IMU and 
encoder. Meanwhile, the observed angular velocity data of the four wheels is determined by the encoder 
integrated with the motors. 
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Figure 5. NURBS trajectory experiment setup for the robot 


4. RESULTS AND DISCUSSION 

To illustrate the application and relevance of the time-varying parameter PID controller, we are 
going to compare the simulation and experiment results of the MWMR with the setting parameters in 
section 3. Figure 6(a) shows the motion trajectory followed by the robot includes desired, simulated and 
measured values includes desired, simulated and measured values. Here, the line no. 1 is the desired value, 
the line no. 2 is the measured value and the line no. 3 is the simulated value. Figure 6(b) presents the desired, 
simulated and measured values of linear and angular velocities. It is clear that the measured and simulated 
robot velocities are closed to the desired ones. 


30pm A pee 
[i 4 1 1 
(of | | 
2.5p----- 1g! aa i-----4 @ 0.20 
i] ' f] 1 1 "a 
m E ae E 0.15 
1 g ' f] 1 AN 1 Ss 0 10 
2.0 }---- pot- ; 
x& $ i > ™ 
! I 
A { A i 
B1.5-----+-- 
= \ 
WI 
ae POS, -1.02 
l a Cy 
i \ 3 
0.5H----- 4-454 E 
' Q 
! ie, 
(= artei I 
-1.5 -1.0 
End Point 


Figure 6. Simulation and experiment results of MWMR obtained from time varying paremeter PID controller 
(a) the desired, simulated and measured trajectory and (b) the desired, simulated, and measured values of 
linear and angular velocities 


From Figure 6, it can be seen that the trajectory tracking error between measured and desired values: 
the maximum position error @max is less than 5.5 cm at t=53 s, and the maximum posture error @emax iS 
approximately 10° at =49 s. The cause of the errors between the measured and the desired values are the 
variation of the linear and angular velocities of the MWMR at the inflection points, as shown in Figure 6. In 
addition, there is slippage between the wheel and the road surface, and the problem of robot dynamics has not 
been considered. In contrast, the trajectory tracking error between the simulated and desired values is minor: 
the position error @max is less than 2 cm at t=38 s, while the maximum posture error @gmax is approximately 
1.5° at t=53 s. Figure 7 makes this more clear, in which Figure 7(a) is the error of linear and angular 
velocities between simulated and desired values with evmax=0.00185 m/s at t=48 s and eamax=0.0025 rad/s at 
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t=19 s. Figure 7(b) is the error of linear and angular velocities between measurement and simulation with 
€vmax=0.07 m/s at t=19 s and eomax=0.8 rad/s at t=38 s. Figure 7(c) describes the robot position and posture 
errors during the whole process of trajectory tracking. 
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Figure 7. Evolution of the MWMR errors (a) the velocity errors between simulated and desired values, 
(b) the velocity errors between measured and simulated values, and (c) the position and posture errors 
between measured and simulation 


Figures 6(b), 7(b) and 7(c) show that the measured and simulated values of the robot linear and 
angular velocities are always around the desired value and symmetrically in two arcs: the first arc: 0 -> 7 
(t=0 s to t=30 s) and the second arc 7 -> 0 (t=30 s to t=60 s). The experimental and simulation results versus 
the desired values in Figures 6 and 7 verified that the robot tracks the desired trajectory with minor errors. 
That shows the simplicity and efficiency of the PID controller designed with the time-varying parameters 
proposed by this study. Furthermore, this proposal has overcome the disadvantages of some previous studies 
when using the time-invariant parameter PID controller to control the mobile robot, such as: i) ineffective 
system control because the accuracy is not high; ii) when the robot moves on a complex trajectory with 
variable linear and angular velocities cannot be stabilized asymptotically to an arbitrary point; and iii) the 
traditional PID controller must be combined with another complex modern controller to satisfy the system. 
The speed of the four wheels, as shown in Figure 8, illustrates that the proposed controller has the efficiency 
to control for the robot to perform the above motion since measured and simulated values are always around 
the desired value. 


@, (rad/s) 
@3 (rad/s) 


@> (rad/s) 
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Figure 8. Compare the angular velocities of the four wheels 
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5. CONCLUSION 

From the above results of calculation, simulation, experiment, and discussions this paper achieves 
the following points: i) a time-varying PID controller based on a function of tracking error has been 
developed for the MWMR to complex trajectory tracking. This controller with a simple structure but 
effectively improves performance with a minor error. The performance of the proposed controller is verified 
via simulations and experiments on the platform MWMR. Therefore, this is the difference between this study 
versus previous studies; ii) we believe that the investigation method to determine the time-varying 
coefficients of the PID controller with variable set value in this study will yield guarantees on the tracking 
performance for the MWMR. Similarly, can apply research results of this paper for any desired trajectory 
with minimal control action and perfect orientation of the MWMR. Also, the problems of dynamic control, 
working load, electromechanical interaction between the robot and the environment, and friction between 
wheel and road surface, to improve and improve the accuracy of the robot will be considered part of our 
future research goals. 
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